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ДЕМПФИРОВАНИЕ КОЛЕБАНИЙ ЗАХВАТНОГО УСТРОЙСТВА 
ПРОМЫШЛЕННОГО РОБОТА В РЕЖИМЕ ДВУХТОКОВОГО ДИ- 
НАМИЧЕСКОГО ТОРМОЖЕНИЯ АСИНХРОННОГО ДВИГАТЕЛЯ 
ПРИ ЧАСТОТНОМ УПРАВЛЕНИИ 


Предложен метод уменьшения амплитуды колебаний звена подвижности (руки) 
промышленного робота, захватного устройства в режиме позиционирования. Осо- 
бенностью метода является использование двухтокового динамического торможе- 
ния асинхронного двигателя, работающего по схеме «АИН-АД» в режиме частотно- 
го управления. Программное формирование тормозного момента на валу асин- 
хронного двигателя посредством взаимного поворота векторов магнитного поля 
статора и ротора с учетом амплитуды и фазы колебаний звена подвижности про- 
мышленного робота позволяет создать условия демпфирования и повысить 
точность позиционирования ЗУ при выполнении транспортных и технологических 
операций. 
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вое динамическое торможение, асинхронный двигатель, электромеханическая си- 
стема, «ползучая скорость», датчики, точность позиционирования. 


Введение. При частотном управлении скоростью асинхронного двигателя 
(АД) электромеханической системы (ЭМС), в частности, звеном подвижно- 
сти захватного устройства (ЗУ) промышленного робота (ПР), эффектив- 
ность работы последнего зависит от ряда факторов. К важнейшим из них 
следует отнести такой параметр, как точность позиционирования, опреде- 
ляющая возможности ПР при выполнении транспортных и технологических 
операций. Понятие точности в дискретных технологических процессах, вы- 
полняемых ПР с позиционной системой управления, связано с конечным 
положением рабочего органа (РО) или ЗУ и характеризуется погрешностью 
позиционирования РО. Процессы с непрерывными технологическими цик- 
лами связаны с применением контурных систем управления, если ставится 
задача по воспроизведению траектории движения РО. Рассматриваемые 
погрешности (позиционирования и отработки траектории РО) являются за- 
висимыми параметрами от кинематических ошибок и передач отдельных 
степеней подвижности ПР. Поскольку ПР работают при больших скоростях 
и повышенных динамических нагрузках звеньев, появление деформаций 
несущих конструкций и неравномерность вращения ротора АД (при пони- 
женной скорости перемещения звена подвижности к точке позиционирова- 
ния), вызывают вибрации и колебания ЗУ. Известно [1,2], что при проекти- 
ровании таких роботов появляется противоречие между быстродействием 
и точностью позиционирования, исключить которое достаточно сложно. По 
мнению авторов, влияние вибрации и колебаний на позиционирование ЗУ 
можно уменьшить, если ввести управляемое формирование момента тормо- 
жения и ограничение амплитуды колебаний захватного ЗУ при выходе его 
в точку позиционирования. В этом случае можно использовать некоторые 
особенности работы частотно-управляемой системы «АИН-АД» [1], когда 
задача решается программно в процессе регулирования скорости АД, рабо- 
тающего в зонах пониженных и «ползучих» скоростей движения 
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исполнительного механизма (ИМ) электромеханической системы 
(ЭМС). 

Предлагаемое решение прошло экспериментальную проверку [3] и под- 
твердило основные положения метода. 

Постановка задачи. Для повышения точности позиционирования РО, в 
частности, ЗУ ПР необходимо предложить метод демпфирования колебаний 
выходного звена подвижности (руки) с консольным креплением в направ- 
ляющей цилиндрической системы координат ПР «Электроника НЦТМ-01» 
(рис.1). Исследования по повышению точности позиционирования ЗУ про- 
водятся с использованием управляемого процесса двухтокового динамиче- 
ского торможения АД, работающего по схеме «АИН-АД» [4]. 









































Рис.1. Кинематическая схема звена подвижности ПР: 1 - ис- 
полнительный механизм (конструкция руки робота и направ- 
ляющих звена подвижности); 2 — исполнительный двигатель; 
3 - муфта; 4 - редуктор; 5 — реечная пара 


При анализе расчетной схемы (рис.2) предполагается равномерное 
распределение массы руки робота, а масса ЗУ и транспортируемого груза 
сосредоточены в одной точке. Принятые условия позволяют записать выра- 
жение для веса степени подвижности с объектом манипулирования: 

С = (т+ Мсп): 8, (1) 
где т, Мсл -— масса груза и руки робота (степени подвижности), 
д - ускорение свободного падения. 


а) 6) 


Рис.2. Расчетная схема взаимодействующих усилий 
в направляющих звена подвижности ПР 
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Расчетная схема руки манипулятора с одинарной направляющей 
(рис.2,6) выполнена в предположении равномерного распределения массы 
руки по длине звена подвижности, что позволяет записать: 


= сп" 8, (2) 
а+1 
где а — вылет консоли направляющей (ход объекта манипулирования); 
[— расстояние между опорами. Если учесть диаметр направляющей (и ко- 
эффициент трения Ё между направляющей и втулкой, то неизвестные ре- 
акции в опорах Ал и К» могут быть определены из условия равенства нулю 
изгибающих моментов относительно точек А и В, а моменты трения в опо- 
рах записаны в виде: 

М, = Л.а. 4; М, = Х.а. Вь. (3) 
С учетом выражений (1), (2) и (3) реакции опор А и В можно опре- 

делить по соотношениям [5]: 


2. 6. (а- Г.а]-а:Р-а?)- 2-4. Г.а. (1+ а) 
2 
[+а 
тона. лана | . 74| (5) 
Для поиска деформации руки робота по оси Х в точке А (рис. 2,6) 
используется интеграл Мора [5], что позволяет определить перемещение 
ЗУ под действием приложенных нагрузок из выражения 
а 2 (6) 
где К! и № — коэффициенты при сосредоточенной и распределенной нагруз- 
ках соответственно составят 


ВЕ ; (4) 























а’ 1 Я.Я 
Е 2 = 3 = 
1 6 Е 7 : а м Л) ' (7) 
а‘ ат 1 1 Ра 
= 2. Д.— | -| 3+2. +6. Ха: -+111+| 3+ 4.—- — 
- 24.Е.} а й. | : Л | | а. 
.(8) 


Если под сосредоточенной силой С (см.рис.2) принять алгебраиче- 
скую сумму силы тяжести и силы инерции 
С=-тх-т 8, (9) 
то для перехода к рассмотрению динамики центра масс ЗУ ось направляют 
в сторону действия силы тяжести (по оси Х), и после некоторых подстано- 
вок и преобразований можно записать неоднородное дифференциальное 
уравнение стандартного вида: 
и Я (10) 
ее 


1 
ме ИО ыеа 


; (11) 
т К, 11 
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где Аи1, №: — коэффициенты различия направления силы трения при четных 
и нечетных колебаниях ЗУ. 


Уравнение (10) представляет собой неоднородное дифференциаль- 
ное уравнение второго порядка. Для расчета сил реакций в опорах и ана- 
лиза динамики движения руки ПР (манипулятора), построения зависимо- 
стей колебаний ЗУ в точке позиционирования В выполнены необходимые 
расчеты и проведено моделирование. В результате моделирования были 
получены графические зависимости колебаний ЗУ в точке позиционирова- 
ния (рис.3) при различных массах нагружения. 

















1 й й й й й 
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Рис.3. Графики колебаний ЗУ манипулятора 
в точке позиционирования при различной нагрузке: 
1-1кг; 2 -Зкг; 3—5 кг; 4 -7Укг; 5 -9Экг; 6 - 12 кг 


На основе полученных колебаний, отличающихся амплитудой, фа- 
зой и периодом колебаний, построены взаимные зависимости: амплитуды 
колебаний (рис.4,а) и фазы колебаний (рис.4,6) от массы; амплитуды коле- 
бания от фазы (рис. 4,в). 
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Рис.4. Взаимные зависимости колебаний: амплитуды от массы (а), 
фазы колебаний от массы (6) и амплитуды колебаний от фазы (в) 
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Решение задачи по снижению колебаний ЗУ в процессе работы ПР, 
по предложению авторов, возможно с использованием принципа «двухто- 
кового» динамического торможения АД [4], когда управление ЭМС осуще- 
ствляется по схеме «АИН-АД» и программно (по разработанному алгорит- 
му), а вектор магнитного потока статора АД может формироваться с углом 
отставания или опережения относительно ротора. Неравномерность вра- 
щения (перемещения) РО машины, включающей механизмы с постоянным 
передаточным отношением (зубчатых, шестерня - рейка и др.), зависит не 
только от соотношения сил движущих и сил технологического сопротивле- 
ния, но и от фактора появления пульсирующего момента вращения на валу 
АД в зоне «низких и ползучих скоростей» [2] перемещения ИМ при гармо- 
нических составляющих тока статора. 

Математическая модель объекта управления. С учетом реально су- 
ществующих звеньев ИМ кинематическую схему (см.рис.1) можно рассмат- 
ривать как классическую схему двухмассовой модели звена подвижности 
ПР (рис.5) с электромеханическим преобразователем (с двумя вращающи- 
мися инерционными элементами | * |и| * |), связанными упругим звеном с 


жесткостью С12. 


МО а 


( ‚) Ры 


Ма (ф,) 


Рис.5. Двухмассовая модель звена подвижности ПР 
с электромеханическим преобразователем 




















Математическая модель составлена для упрощенного варианта, 
когда двухмассовая модель приведена к эквивалентной одномассовой мо- 
дели, что позволяет записать для АД следующую систему уравнений: 
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И а а 
Л: = 2 Р.Р2` (И -. па )- Мь›- Ме - Мг; 
1.05 = Мр- Ме; 
М1 = ср. (%1-%5)+812.(0,-9,); 


ф:=0,:;95=@ 5; А6’= К, 0, (12) 

где и, =Он’1:с05(0 1); из = Мн: 5т(а 1); Ц = + Е 
Г, уй Ё 
15 = [+ 2;6= ! = - = г 





Е о ЕЕ 

[1 — Ра [1 ы [> 7] Г. [2 
Однако уравнения (12) не учитывают изменений в динамическом 
моменте на валу АД, возникающих при подаче постоянного тока управле- 
ния в обмотки статора АД. Упрощенно указанное влияние можно ввести в 
математическую модель, дополнив ее уравнениями, в которых отражен 
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фактор влияния изменяющихся параметров, включенных в указанные зави- 
СИМОСТИ: 


1120 2 





’_ ГА 13 
(1- 512 |+ (120 1+в}|' Г. 
- 5 
и. | 
ЗИ." [1-3 -- НЫ ы 
[ Я: Я ни (14) 
| и т ВН 
В м | 
а. 
| А 
(Мо Мой В НА 


[5 | 


В уравнения (12)-(14) введены следующие обозначения: Их, 22а, Ав, 
7>в — токи в обмотках статора и ротора по координатным осям ( и В; 
Ша, Илв — напряжения на обмотках статора по осям ( и В; #*, же - 
активное сопротивление ротора и статора соответственно; Ил, 15, 112 
— индуктивности статора и ротора и взаимная индуктивность; 51, (2 - 
индуктивности рассеяния обмоток статора и ротора; Р’- число пар полю- 
сов статора АД; С, У, Ц - действующее и относительное значения, 
частота входного напряжения; с1>, В12 - коэффициент жесткости и со- 
противления между массами ведущего и ведомого вала; Ло, Ау - пере- 
мещение и коэффициент пересчета (усиления) выходного звена по пути; 
М> - момент упругого взаимодействия; ЛИ са, М с -— момент трения 
на валу АД и статический момент нагружения выходного вала; -/1, „/> — 
моменты инерции ведущего и ведомого валов ИМ; Ф!, Ф> - углы дефор- 
мации, 521, © › - скорости ведущего и ведомого валов ИМ; © ;/ - угло- 
вая скорость вращения поля статора; Л/ у. — тормозной момент, обуслов- 
ленный протеканием постоянной составляющей тока статора в режиме 
двухтокового динамического торможения; /›’ — постоянная составляющая 


тока статора в режиме двухтокового динамического торможения; $ — сколь- 
жение. 

Для уменьшения неравномерности вращения вала АД в [1,2] 
предложены специальные режимы работы АИН, обеспечивающие формиро- 
вание выходной частоты тока фаз статора синусоидальной формы от 0,1 Гц 
и выше. Сохранение «синусоидальности» формы токов фаз статора АД в 
широком диапазоне позволяет избежать пульсирующих моментов на валу 
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АД и уменьшить колебания ЗУ от влияния внешних сил, что должно соблю- 
даться при осуществлении режима двухтокового динамического торможе- 
ния АД. 

Двухтоковое динамическое торможение АД. Эффект возникновения 
на валу тормозного момента при питании статора постоянным током [6] 
позволяет совместить частотный и динамический режимы торможения при 
одновременном управлении переменным и постоянным токами в обмотках 
статора. При этом формируются расчетные динамические моменты на валу 
АД в режиме торможения и исключаются возможные удары в механической 
части ЭМС [7]. Такая система управления АД позволяет (по сигналам дат- 
чиков контролируемых величин) в соответствии с приведенными зависимо- 
стями (рис. 4) формировать целесообразное торможение звена подвижно- 
сти в режиме демпфирования колебаний амплитуды ЗУ на определенном 
уровне (от 0,2 до 0,7 мм), зависимых от чувствительности датчиков и уси- 
ления сигналов в СУ. В общем случае процесс торможения АД можно 
рассматривать как результат взаимодействия эквивалентного двигательно- 
го и тормозного моментов, обеспечиваемых равенством намагничивающих 
сил (н.с.) постоянного тока подмагничивания статора [7,9] и приведенного 
переменного тока ротора. В этом случае результирующий момент на валу 
АД в режиме управляемого динамического торможения можно представить 
в виде алгебраической суммы действующих моментов в зависимости от 
уровня скорости (42), скольжения (5$) по уравнению, т.е. 


3.071. в - 3 Роб. в 





,\2 } „ \2 


5. Е + [201+ 250 |] (1- 5).@,. —. + [150+ 5)” 


‚ (15) 

На рис.б построены качественные характеристики раздельного и 
совместного процессов динамического торможения системы «АИН-АД» при 
параметрическом способе регулирования скорости АД серии 4АА50А2УЗ 
мощностью 90 Вт, {2, = 314 рад/с. 

На приведенных характеристиках обозначены: а — изображающая 
точка на естественной характеристике 1 двигательного режима работы АД 
при скорости (2=28 рад/с; а а, аз — изображающие точки на совместных 
механических характеристиках соответственно С1, ©, Сз, полученных с уче- 
том характеристик 2,3,4 для скорости 2=28 рад/с при разных токах подмаг- 
ничивания; а, — изображающая точка совокупной характеристики, рассчи- 
танная для скорости @=28 рад/с при токе подмагничивания /=0,05-0,25 А. 
Построение совместных механических характеристик С!-Сз сопряжено с ря- 
дом трудностей, обусловленных различием используемых электротехниче- 
ских сталей магнитной системы [7,8] и достаточно сложными зависимостя- 
ми между активными, индуктивными составляющими параметров АД при 
насыщении сердечников статора и ротора в зоне пониженных скоростей 
работы АД [1,2]. Ранее применяемая горячекатаная изотропная электро- 
техническая сталь (1212 (912), 1312 (522), 1412(932) по ГОСТ 
21427.3) в настоящее время в производстве электрических ма- 
шин заменена холоднокатаной изотропной электротехнической сталью 
(2011, 2312, 2411, а также 2211, 2212, 2311,2412 по ГОСТ 21427.2 - 83). 
Вследствие высокой магнитной проницаемости указанной стали, понижен- 
ных удельных потерь при перемагничивании, малой разнотолщинности 
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и разноплоскостности структуры расчетные параметры АД необходимо со- 
ответственно корректировать. Применение указанных сталей в электрома- 
шиностроении позволяет повысить магнитные нагрузки, в частности, по 
напряженности (Я, А/см) в 1,5 -2 раза. 
























































0 
"2 #1.5 "| =0.5 0 0.5 1 


Рис.б. Траектории движения изображающих точек на механических 
характеристиках АД: 1 - естественная; 2,3,4 — динамического торможения; 
С, С, С - совместные в режиме «двухтокового» динамического торможения 


Результаты моделирования системы с дополненными уравнениями, 
отражающими фактор влияния изменяющихся параметров АД при введе- 
нии контура подмагничивания током /л, получены с использованием схемы 
объекта исследования, разработанной в Утик (МаНаБ 6.5.) и дополнен- 
ной специальными блоками [9]. Параметры АД (серии 4АА5ОА2УЗ, мощно- 
стью 90 Вт) использовались в качестве параметров блока АзупсНгопои$ Ма- 
сНпе. При этом движение изображающей точки 1 (рис. 6), расположенной 
на механической характеристике Д1 (двигательного режима) в точке уста- 
новившейся скорости движения ИМ, соответствует соотношению Мн = Мс 
при скорости вращения вала {2-=,. Режим торможения начинается с плав- 
ного понижения напряжения Ши Ё согласно принятому закону И/Ё=соп5Е 
для исключения динамических ударов в приводной системе и исполнитель- 
ном механизме. 

В режиме «мягкого» торможения электропривода (от точки 1 до 
точки 2) при частотном управлении скорость вращения АД изменяется с 
сохранением момента Мн. Введение в точке 2 механической характеристики 
{2=КМ) режима динамического торможения состояние АД соответствует 
двухтоковому торможению с плавным формированием тормозного момента 
—Мл и снижению скорости от точки 2 до точки 4 по кривой 71. Участок ха- 
рактеристики 2-3-4 (рис.7) имеет плавные переходы изменения скорости, 
обусловленные постоянной времени нарастания постоянного тока в об- 
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мотке управления. В дальнейшем изменение скорости реализуется при по- 
стоянном тормозном моменте —/М т: (постоянном ускорении торможения -—=т) 
от точки 4 до 4’ что соответствует изменению скорости при постоянном 
тормозном моменте. На участке изменения скорости (точки 4' - 5) характе- 
ристики изменяется режим работы АИН таким образом, что на «ползучей» 
скорости развивается момент вращения на валу АД, а тормозной момент 
при уменьшении тока подмагничивания /7 уменьшается и АД работает под 
активным моментом на валу, снижая скорость от точки 5 до точки 7. Затем 
из точки 7 до точки 8 двигательного режима АД скорость снижается до 
полной остановки приводной системы промышленного робота при про- 
граммном формировании вектора магнитного поля статора (за счет измене- 
ния алгоритма работы АИН) с отставанием на 1-2 электрических градуса от 
вектора магнитного потока поля ротора. 


0, об/мин 


1800 -— 











-Мт | 
| т | | т 
—0,8 —0,4 0 0,4 0,3 1,2 
Рис. 7. Механические характеристики трехфазного асинхронного двигателя: 
Д, Т - двигательный и тормозной режимы работы АД 





При этом для обеспечения постоянства тормозного момента, уско- 

рения торможения (участок 4-4") регулирование величины постоянной со- 
ставляющей тока статора находится в зависимости от текущих значений 
частоты Ёи напряжения И питания АД от АИН, угловой скорости вращения 
ротора ® и момента на валу АД по принятому закону. Так как данный прин- 
цип торможения позволяет поддерживать постоянным ускорение, появ- 
ляется возможность точной остановки позиционного привода промышлен- 
ного робота в заданной точке. 
Моделирование. При моделировании АД ротор машины замыкается нако- 
ротко, статор питается от АИН с ШИМ-модуляцией (рис. 8). Основная ча- 
стота синусоидального напряжения изменяется от 0 до 60 Гц, а несущая 
частота имеет треугольную форму и равна 1980 Гц. Согласно рекомендаци- 
ям [9,10], коэффициент частотной модуляции т/ должен быть нечетным и 
кратным трем, т.е. п7Ё = 33, что обеспечивает установленную несущую ча- 
стоту 60х33=1980 Гц. 
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Паспортные данные асинхронного двигателя 4АА50А2УЗ использу- 
ются в качестве параметров блока Азупспгопои$ МасИте, электромагнит- 
ный момент торможения от постоянного тока управления задается с помо- 
щью блока ТЕ, который построен как 5-РипсЧоп по уравнениям (13) и (14) и 
подается на вход Тт блока асинхронного двигателя (АзупсИгопои$ МасНте) 
в расчетный момент времени. 

Результаты моделирования. При запуске математической модели в 
отийпк моделирование подтвердило ожидаемые результаты по характер- 
ному изменению параметров скорости (рис.9) при пуске и торможении АД, 
а также соответствие формируемых моментов (рис.10) в процессе пуска и 
реализации двухтокового динамического торможения. Изменения скорости 
при торможении (точки 1-8, рис.9) соответствуют характеру формирования 
кривой (Т1) при динамическом торможении и полностью совпадают с ра- 
нее приведенными пояснениями (см.рис.7). Здесь участок 4-4’ характери- 


стики © = /(-М,;) имеет достаточный диапазон изменения скорости (0 ) 


при изменении тормозного момента не более 5-10% от установленного 
программно при торможении, что позволяет производить торможение при- 
вода ПР (ЭМС) с постоянным ускорением торможения, без ударов в кинема- 
тической схеме передаточного механизма. На участке 4-7 имеет место 
плавное снижение скорости движения ЗУ (руки ПР), когда АД из режима 
тормозного переходит в двигательный режим, формируя зону «ползучей» 
скорости движения ЗУ. При этом ЗУ перемещается с пониженной скоростью 
до полной остановки в точке позиционирования (участок 7-8), а управляе- 
мое «подтормаживание» АД в противофазе колебаниям ЗУ снижает ам- 
плитуду последних и способствует повышению точности позиционирова- 
ния. При программном формировании управляемых динамических режимов 
ПР особую значимость имеет экспериментальное определение диапазона 
изменения тока подмагничивания статора постоянным током, исходя из 
условий желаемого демпфирования колебаний ЗУ при позиционировании. 
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Рис. 9. Изменение скорости при разгоне и динамическом торможении АД 
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Рис.10. Результаты моделирования 
пускового и тормозного моментов 


Выводы. Метод управляемого двухтокового динамического торможения 
перспективен для широкого применения в системах частотного управления 
АД электроприводов ПР, позволяет программно управлять формировани- 
ем уровня и фазой включения тормозного момента (в противофазе колеба- 
ниям руки ПР) с целью демпфирования колебаний звена подвижности ЗУ. 
Поскольку амплитуда и фаза колебаний являются зависимыми параметра- 
ми от масс и моментов инерции подвижных звеньев ПР, то момент фор- 
мирования режима «подтормаживания» на низких и «ползучих» скоростях 
движения ЗУ должен осуществляться с учетом чувствительности датчиков 
контроля указанных параметров. 
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МТТН ЕКЕОЧЕМСУ СОМТВОЕ 
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